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Abstract 

In this paper, a Kalman filter formulation for attitude estimation is derived 
using the Modified Rodrigues Parameters. The extended Kalman filter 
uses a gyro-based model for attitude propagation. Two solutions are 
developed for the sensitivity matrix in the Kalman filter. One is based upon 
an additive error approach, and the other is based upon a multiplicative 
error approach. It is shown that the two solutions are in fact equivalent. 

The Kalman filter is then used to estimate the attitude of a simulated 
spacecraft. Results indicate that the new algorithm produces accurate 
attitude estimates by determining actual gyro biases. 

Introduction 

A widely used parameterization for attitude estimation is the quaternion representation. Advantages 
of using quaternions include: 1) the kinematic equations are linear with respect to angular velocities, 2) 
singularities are not present for any eigenaxis rotation, and 3) the attitude matrix is algebraic in the 
quaternion components. However, since the quaternion parameterization involves the use of four 
components to represent the attitude motion, the quaternion components are non-minimal (dependent). 
This leads to a constraint that the quaternion must have unit norm. 

The quaternion normalization constraint produces a singularity in the Kalman filter covariance matrix. 
Three solutions (two of which yield identical results) to this problem are summarized by Lefferts et al. 
[1]. The first approach uses the transition matrix of the state-error vector to obtain a reduced order 
representation of the error covariance. The second approach deletes one of the quaternion components 
in order to obtain a truncated error covariance expression. The third approach uses an incremental 
quaternion error which results in a representation that is identical to the first approach. This approach is 
most commonly used to maintain normalization for the estimated quaternion. 

Three-dimensional parameterizations of attitude are still useful for many control applications (e.g., see 
[2-3]). Since spacecraft control algorithms require estimates of attitude and/or rate, it is therefore 
advantageous to develop a Kalman filter which utilizes a three-dimensional parameterization. A number 
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of three-dimensional parameterizations is shown in an excellent survey by Shuster [4]; including, the 
Euler angle representation, the Rodrigues parameters, and the modified Rodrigues parameters. It is 
widely known that all three-dimensional parameterizations have singularities (e.g., the Rodrigues 
parameters are singular for 180 degree rotations [4]). The choice of parameters depends on a number of 
factors; for example, the type of rotation maneuver for the spacecraft, computational requirements, 
physical representation insight, etc. 

Most control applications require a parameterization that has the singularity as far from the origin as 
possible. Specifically, the modified Rodrigues parameters (MRP) [5] have recently been used for 
spacecraft control applications, since they allow for rotations up to 360 degrees. Tsiotras [6] utilized the 
MRP to derive a new class of globally asymptotically stabilizing feedback control laws. Schaub et. al. [7] 
utilized the MRP to estimate external torques by tracking a Lyapunov function. Crassidis and Markley 
[8] utilized the MRP to develop a sliding mode controller for spacecraft maneuvers. However, the 
aforementioned control schemes assume that the attitude (i.e., the MRP) is already known. For this 
reason, a Kalman filter using the modified Rodrigues parameters is developed in this paper. 

The organization of this paper proceeds as follows. First, a brief review of the quaternion and MRP 
kinematic equations is shown. Then, a brief review of the Kalman filter is shown using the quaternion 
representation. Next, a Kalman filter for attitude estimation is derived using the MRP. Also, the 
sensitivity matrix is derived using both an additive and a multiplicative approach. Finally, the new 
algorithm is used to estimate the attitude of the Tropical Rainfall Measurement Mission (TRMM) 
spacecraft. 


Attitude Kinematics 


In this section, a brief review of the kinematic equations of motion using the modified Rodrigues 
parameters is shown. This parameterization is derived by employing a stereographic projection of the 
quaternions. The quaternion representation is given by 


q = 



(i) 


with 



(2a) 

(2b) 


where n is a unit vector corresponding to the axis of rotation and 0 is the angle of rotation. The 
quaternion kinematic equations of motion are derived by using the spacecraft’s angular velocity (co), 
given by 

£ = ( 3 ) 
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where £2 ((d) and z(q) are defined as 


fi(co) = 


-[to x] : to 


— 0 ) i 0 



<74^3x3 + £ 13 x 



(4a) 


(4b) 


where / 3x3 is a 3x3 identity matrix. The 3x3 dimensional matrices [to x] and x] are referred to as 
cross product matrices since axb = [ax]b, with 
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(5) 


Since a three degree-of-freedom attitude system is represented by a four-dimensional vector, the 
quaternions cannot be independent. This condition leads to the following normalization constraint 




( 6 ) 


The modified Rodrigues parameters are defined by [5] 



(7) 


where p is a 3x1 vector. The kinematic equations of motion are derived by using the spacecraft’s 
angular velocity (co ), given by [4] 


P 



ffl-2(ox p + 2 



( 8 ) 


where | | is the norm operator, and • is the dot product. This equation may be re-written as 

P = ^\^( l -P T p)hxi+[px]+pp T }® 

The measurement model is assumed to be of the form given by [4] 

B-b - a(p)£i 


(9) 

( 10 ) 


where B, is a 3x1 dimensional vector of some reference object (e.g., a vector to the sun or to a star, or 
the Earth’s magnetic field vector) in a reference coordinate system, B b is a 3x1 dimensional vector 
defining the components of the corresponding reference vector measured in the spacecraft body frame, 
and A[p) is given by 
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( 11 ) 


A(p) = hx3 - 


M}-p t p) 


Le x ]' 


(\ + p r pf V J (l + P T P)' 

which is the 3x3 dimensional (orthogonal) attitude matrix. 


-H 2 


Kalman Filter Development 

In this section, a Kalman filter is derived for attitude estimation using the modified Rodrigues 
parameters. First a brief review of basic principles of the Kalman filter using quaternions is shown (see 
[1] for more details). The state error vector has seven components consisting of a four-component error 
quaternion (§<? ) and a three- vector gyro bias error A b , given by 




( 12 ) 


The error quaternion is defined as 


5 q = q®q 


--1 


(13) 


where q is the true quaternion and £ is the estimated quaternion. Also, the operator ® refers to 
quaternion multiplication (see [4] for details). Since the incremental quaternion corresponds to a small 
rotation. Equation (13) can be approximated by 




(14) 


which reduces the four-component error quaternion into a three-component (half-angle) representation. 
Equation (14) is then used to derive a quaternion based Kalman filter (see [1] for details). 

The state equation for the new algorithm consists of the modified Rodrigues parameters (p) and a 

gyro bias corrections (b), given by 


x = 


P 

b 


(15) 


The true angular velocity is assumed to be modeled by 

( 0 = 5 -^-^ ( 16 ) 

where a is the true angular velocity, 5 is the gyro-measured angular velocity, and b is the gyro drift 
vector, which is modeled by 

b = (17) 

The 3x1 vectors, and r\ 2 , are assumed to be modeled by a Gaussian white-noise process with 
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£{»:(<)} = o 

E{w(t)w T (t')} = Qb(t-t') 


The true state-model equation can now be written as 


£ = f(P’b,&,t) + g(p^ v t) 


b = r 


where 


f(p>k&,t) = \\l(l-p T p)l3x3 +[p*\ + PP T }{<!± -k) 


g(p^r t ) = -^\\{ l -P T p) I 3x3 + [p>] + PP T }^ l 


(20b) 


The extended Kalman filter utilizes a first-order Taylor series expansion for the state-error equation, 
given by 


where 


Ai = F Ax + Gw 

' 3 / : *1 

dp db 
°3x3 : °3x3 
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(22a) 


(22b) 


°11 = |~ = ‘Hif 1 -P T p)h*3 + [£ x ] + ££ r } 


G 12 = G 21 = °3x3 
G 22 =/ 3x3 

The estimated state-error equation is given by 

Ax = F\ x= %Ax = F Ax 


(23a) 


(23b) 

(23c) 


(24a) 
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(24b) 


i A A 

Ax = x-x 

The partial derivatives in Equation (24a) for the state-error matrix are given by 

= \{m T ~®P T "I® ><] + (® r £)^3x3} 

x=x 

= -|{|( 1 -£ T £) / 3x3+[px] + ££ r } s<5 'l 

where 

State-observable discrete measurements are assumed to be modeled by 

z k =h k (x k )+v k 

where 

h k (x k ) = A[p k )B h 

and v k is assumed to be modeled by a zero-mean Gaussian process with 

£ { v *}=2 

e{v 4 v[} = RS k , 

The sensitivity matrix can be written as 

H k =[L : 0 3x3 ] 


a/ 

dp 

a/ 
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(25a) 

(25b) 

(26) 

(27) 

(28) 

(29a) 

(29b) 

(30) 


where L can be derived using an additive approach or a multiplicative approach. The additive approach 
expands h k (x k ) in a power series about x k , given by 


h k {x k ) = h k {x k ) + — 


dp 


A *k 


(31) 




The brute force differentiation in Equation (31) can be shown to be given by 




dp 


it =** 
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which is somewhat complicated. The multiplicative approach assumes that the true parameters are given 
by 

p = hp®p (33) 

where bp is the error MRP. The composition rule for the MRP leads to the following 

P = ~ \ — 5 

1 + |8£| |/?| -25 p»p 

For small 8 p , Equation (34) can be approximated using 



p~{l + 26p»pj ^l-Jpj 2 j8£ + p-2^5/?xjp 
~P + f 1 -|l| 2 V3x3+2[px] + 2 i£ r l 8 £ 


(35) 


From 

a (p) = A { d E) A (p) (36) 

it follows that 

= jz A ( & P) A (p)Bi ( 37 ) 

x k =x k l - p 

and using the fact that for small 8 p 

A {^p) ~ ^3x3 ~4 [§£x] (38) 

Equation (37) can now be evaluated using the chain rule to yield 

i. = 4[A(p)B,> < ]{(l-£ 7 '£)/3 x 3+2[px]+ 2 pp 7 'r 1 

h 

<39) 

= T T-t[' 4 (|)«/ x ]{( 1 -£ 7 '£) / 3x3-2[£x]+2££ 7 '} 

( 1+ £ Q 

l k 

which is in a simpler form as compared with Equation (32). In fact, these equations are identical, thereby 
proving the equivalence between a multiplicative and an additive approach for the MRP in the Kalman 
filter. Also, the matrix in Equation (39) has at most rank two, which reflects the fact that the observation 
vector contains no information about rotations around an axis specified by that vector at each 
measurement point. The extended Kalman filter equations for attitude estimation are summarized by 
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where 


x = fix,t) 

(40a) 

P = FP+P t F+GQG t 

(40b) 

i*(+) - a*(£* ( ->)] 

(40c) 

flt(+) =[W - a* 

(40d) 

K k = flt(-) Hl[H k 

(40e) 

Gn • °3x3 


G = ••• : ••• 

(41) 

°3x3 • 7 3x3 



Spacecraft Simulation and Results 

A simulation study is performed using the Tropical Rainfall Measurement Mission (TRMM) 
spacecraft orbit parameters. The TRMM spacecraft (see Figure 1) is due to be launched in 1997 with a 
nominal mission life of 42 months. The main objectives of this mission include: (i) to obtain multi-year 
measurements of tropical and subtropical rainfall, (ii) to understand how interactions between the sea, air, 
and land masses produce changes in global rainfall and climate, and (iii) to help improve the modeling of 
tropical rainfall processes and their influence on global circulation. The simulated spacecraft has a near 
circular orbit at 350 km. The nominal mission mode requires a rotation once per orbit (i.e., 236 deg/hr) 
about the spacecraft’s y-axis while holding the remaining axis rotations near zero. The attitude sensors 
used in the simulation include a three-axis magnetometer (TAM) and two digital sun sensors (DSSs). 

The magnetic field reference is modeled using a 10th order International Geomagnetic Reference 
Field (IGRF) model. TAM sensor noise is modeled by a Gaussian white-noise process with a mean of 
zero and a standard deviation of 0.5 mG. The two DSSs each have a field of view of about 50° x 50°, and 
combine to provide sun measurements for about 2/3 of a complete orbit. Figure 2 shows the availability 
of the sun sensor as a function of time. The DSS sensor noise is also modeled by a Gaussian white-noise 
process with a mean of zero and a standard deviation of 0.05°. The gyro “measurements” are simulated 
using Equations (16) and (17), with a gyro noise standard deviation of 0.062 deg/hr, a ramp noise 
standard deviation of 0.235 deg/hr/hr, and an initial drift of 0.1 deg/hr on each axis. 

A plot of the estimated MRP for a typical simulation run using the extended Kalman filter is shown in 
Figure 3. Since, the rotation does not exceed 360° a discrete jump to the origin is not required. A plot of 
the corresponding gyro-bias estimates is shown in Figure 4. Plots of the attitude covariance and gyro- 
bias covariances are shown in Figures 5 and 6, respectively. The increase in the attitude covariance (at 
approximately the second and fifth hour) is due to the fact that the rotation approaches 360° as shown in 
Figure 7 (i.e., the fourth quaternion component is close to 1). A plot of the roll, pitch, and yaw attitude 
errors is shown in Figure 8. From these figures, it is clear that the extended Kalman filter developed in 
this paper is able to accurately estimate the attitude and gyro-biases of the simulated spacecraft, and 
achieves the same degree of accuracy as the quaternion-based Kalman filter (see [9]). 
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= sun available, 0 = not available 



Figure 1 TRMM Spacecraft 


Sun Availability 
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Estimated Modified-Rodrigues Parameters 



Figure 3 Plot of Kalman Filter MRP Estimates 


Kalman Filter Gyro-Bias Estimates 



Figure 4 Plot of Kalman Filter Gyro-Bias Estimates 
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Conclusions 


In this paper, a Kalman filter was developed for attitude estimation using the modified Rodrigues 
parameters. Conceptually, the computational requirements for the new algorithm are comparable to the 
quaternion-based Kalman filter. However, the formulation shown in this paper avoided the normalization 
constraint associated with the quaternion representation. Therefore, methods to maintain a singular 
covariance matrix using the quaternion representation in the Kalman filter have been eliminated. 
However, a singularity exists for 360 degree rotations. This may be avoided by allowing for a discrete 
jump to the origin when the rotation approaches the singularity. Simulation results indicate that the new 
algorithm was able to accurately estimate for the spacecraft attitude and the gyro-biases. 


Acknowledgments 

The first author’s work is supported by a National Research Council Postdoctoral Fellowship tenured 
at NASA-Goddard Space Flight Center. The author greatly appreciates this support. Also, this author 
wishes to thank Malcolm D. Shuster for introducing him to the modified Rodrigues parameters. 


References 

[1] Lefferts, E.J., Markley, F.L., and Shuster, M.D., “Kalman Filtering for Spacecraft Attitude 
Estimation,” Journal of Guidance, Control and Dynamics , Vol. 5, No. 5, Sept. -Oct. 1982, pp. 417-429. 

[2] Ramirez, H.S., and Dwyer, T.A.W., “Variable Structure Control of Spacecraft Reorientation 
Maneuvers,” Proceedings of AIAA Guidance, Navigation, and Control Conference, Williamsburg, VA, 
Aug. 1986, AIAA Paper #86-1987, pp. 88-96. 

[3] Slotine, J.-J.E., and Di Benedetto, M.D., “Hamiltonian Adaptive Control of Spacecraft,” IEEE 
Transactions on Automatic Control, Vol. 35, No. 7, July 1990, pp. 848-852. 

[4] Shuster, M.D., “A Survey of Attitude Representations,” The Journal of the Astronautical Sciences, 
Vol. 41, No. 4, Oct.-Dec. 1993, pp. 439-517. 

[5] Marandi, S.R., and Modi, V.J., “A Preferred Coordinate System and Associated Orientation 
Representation in Attitude Dynamics,” Acta Astronautica, Vol. 15, No. 11, Nov. 1987, pp. 833-843. 

[6] Tsiotras, P. “Recent Results on the Attitude Control Problem,” Journal of Guidance, Control and 
Dynamics, in review. 

[7] Schaub, H., Junkins, J.L., and Robinett, R.D., “Adaptive External Torque Estimation by Means of 
Tracking a Lyapunov Function,” Proceedings of the AAS/AIAA Space Flight Mechanics Meeting, 
Austin, TX, Feb. 1996, AAS Paper #96- 172. 

[8] Crassidis, J.L., and Markley, F.L., “Sliding Mode Control Using Modified Rodrigues Parameters,” 
Journal of Guidance, Control and Dynamics, in review. 

[9] Crassidis, J.L., Andrews, S.F., Markley, F.L., and Ha, K., “Contingency Designs for Attitude 
Determination of TRMM,” Proceedings of the Flight Mechanics/Estimation Theory Symposium, NASA- 
Goddard Space Flight Center, Greenbelt, MD, 1995, pp. 419-433. 


83 




